Methods of tracking pedestrian heading angle using smart phones data for pedestrian safety applications

ABSTRACT

This presentation provides methods to track pedestrians heading angle using smart phone data. Tracking heading angle especially at or from stationary position is key for pedestrian safety, e.g., for smart cross system and pedestrian collision mitigation system. It provides pedestrian-to-vehicle (P2V) platform. It deploys smart phones or mobile devices, equipped with DSRC (Dedicated short range communication) support, to act as beacons for pedestrians: Phone can alert driver to pedestrian presence in path; Pedestrian Basic Safety Message (BSM) can aid awareness for vehicles; It can be used for bicycles, as well. It also provides pedestrian-to-infrastructure (P2I) platform. Smart phone, through DSRC/cellular, transmits pedestrian presence to crosswalks/signals: It enables advanced crosswalk lighting/warning scheme; It enables bundling of pedestrian presence to vehicles. In this presentation, we provide various examples and variations on these.

RELATED APPLICATIONS

This application is a CIP of another co-pending US utility application,namely, Ser. No. 14/163,478, filed 24 Jan. 2014, titled “System andmethod for creating, storing, and updating local dynamic MAP databasewith safety attribute”, which is a CIP of another co-pending US utilityapplication, namely, Ser. No. 14/047,157, titled “System and method formap matching”, filed 7 Oct. 2013, now a U.S. Pat. No. 9,037,404, issuedon May 19, 2015, which in turn is a CIP of two other co-pending USutility applications, namely, Ser. No. 13/907,864, titled “System andmethod for lane boundary estimation and host vehicle position andorientation”, filed 1 Jun. 2013, and Ser. No. 13/907,862, titled “Systemand method for node adaptive filtering and congestion control for safetyand mobility applications toward automated vehicles system”, filed 1Jun. 2013. It is also related to another US patent application filed 24Jan. 2014, Ser. No. 14/163,258, with the same assignee, titled “Systemand method for road side equipment of interest selection for activesafety applications”. The teachings of all the above applications areincorporated herein, by reference. The current application claims thepriority date of the above applications.

BACKGROUND OF THE INVENTION

The autonomous cars or vehicles are subject of intense research today.The safety is one of the most important issues in this technology. Webelieve that pedestrians are one of the main actors in this environment.Thus, the pedestrians safety is one of the main issues in our researchand development. At Savari, our technology incorporates a platform forpedestrians' safety. The more we guard the pedestrians against theaccidents, the less risk is imposed on public, and the more publicacceptance for autonomous cars or vehicles is generated.

One aspect of the present invention relates to a system that uses asmart crossing module to safeguard and monitor the pedestrians in thestreets or at the cross walks or at the intersections.

There is no prior art or product in the industry that teaches thefollowing features in our disclosure here.

SUMMARY OF THE INVENTION

This disclosure, e.g., adds the following improvements on our platformtechnologies, as some of the embodiments:

It provides methods to track pedestrians heading angle using smart phonedata. Tracking heading angle especially at or from stationary positionis key for pedestrian safety, e.g., for smart cross system andpedestrian collision mitigation system.

It provides pedestrian-to-vehicle (P2V) platform: It deploys smartphones or mobile devices, equipped with DSRC (Dedicated short rangecommunication) support, to act as beacons for pedestrians:

a. Phone can alert driver to pedestrian presence in path.

b. Pedestrian Basic Safety Message (BSM) can aid awareness for vehicles.

c. It can be used for bicycles, as well.

It provides pedestrian-to-infrastructure (P2I) platform: Smart phone,through DSRC/cellular, transmits pedestrian presence tocrosswalks/signals:

a. It enables advanced crosswalk lighting/warning scheme.

b. It enables bundling of pedestrian presence to vehicles.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is for one embodiment, as an example, for representation ofdevelopment of fully automated vehicles, in stages.

FIG. 2 is for one embodiment of the invention, for a system forautomated vehicles.

FIG. 3 is for one embodiment of the invention, for a system forautomated vehicles.

FIG. 4 is for one embodiment of the invention, for automated vehiclefunctional architecture.

FIG. 5 is for one embodiment of the invention, for automated vehicleinfrastructure architecture.

FIG. 6 is for one embodiment of the invention, for a system for V2Xlandscape, with components.

FIG. 7 is for one embodiment of the invention, for a system forframework for V2I applications, with components.

FIG. 8 is for one embodiment of the invention, for a system forautomated vehicle command and control (C2) cloud, with components.

FIG. 9 is for one embodiment of the invention, for a system for our(Savari) C2 network, with components, showing communications betweennetworks and vehicles.

FIG. 10 is for one embodiment of the invention, for a system for hostvehicle, range of R values, region(s) defined, multiple nodes orvehicles inside and outside region(s), for communications betweennetworks and vehicles, and warning decisions or filtering purposes.

FIG. 11 is for one embodiment of the invention, for a system for hostvehicle, range of R values, region(s) defined, for an irregularshape(s), depending on (x,y) coordinates in 2D (dimensional)coordinates, defining the boundaries.

FIG. 12 is for one embodiment of the invention, for a system forautomated vehicles, with components, with one or more filtering modules.

FIG. 13 is for one embodiment of the invention, for a system forautomated vehicles, with components, with a function FO, e.g., dependingon the velocity of the vehicle, for calculations for Lat and Loncoordinates, and their corresponding deltas or differences.

FIG. 14 is for one embodiment of the invention, for a method forautomated vehicles, for adjusting R dynamically, based on rules engine,historical data, user-interface, or neural network.

FIG. 15 is for one embodiment of the invention, for a system forautomated vehicles, for filtering module, for direction, velocity, anddistance.

FIG. 16 is for one embodiment of the invention, for a system forautomated vehicles, for filtering module, for power, power threshold(s),traffic data, maps, topography, R, number of nodes, and rate of changeof number of nodes.

FIG. 17 is for one embodiment of the invention, for a system forautomated vehicles, for filtering module, for various vehicles.

FIG. 18 is for one embodiment of the invention, for step 1, generatinglanes.

FIG. 19 is for one embodiment of the invention, for step 1, generatinglanes.

FIG. 20 is for one embodiment of the invention, for step 2, Method 1,constructing Intersection (INTX) Diamond Region.

FIG. 21 is for one embodiment of the invention, for step 2, Method 1,constructing INTX Diamond Region.

FIG. 22 is for one embodiment of the invention, for step 2, Method 1,constructing INTX Diamond Region.

FIG. 23 is for one embodiment of the invention, for step 2, Method 3,using lane intersections.

FIG. 24 is for one embodiment of the invention, for step 3, determininglane type. FIG. 25 is for one embodiment of the invention, for step 4,determining approach set.

FIG. 26 is for one embodiment of the invention, for step 5, determiningconnection set.

FIG. 27 is for one embodiment of the invention, for a system ofcreating, storing, and updating local dynamic MAP database with safetyattribute.

FIG. 28 is for one embodiment of the invention, for a system ofcreating, storing, and updating local dynamic MAP database with safetyattribute.

FIG. 29 is for one embodiment of the invention, for a system of mapgeneration. It generates maps using vehicle data such as location,speed, and heading, along with time stamp.

FIG. 30 is for one embodiment of the invention, for a system of lanegeneration. It constructs lanes by clustering vehicles path andcombining vehicle paths inside the clusters.

FIG. 31 is for one embodiment of the invention, for a system ofdetermining intersection and lanes splitting. It determines intersectionregion using vehicles speed profiles, vehicles heading angles, andvehicles travel path intersects.

FIG. 32 is for one embodiment of the invention, for a system ofdetermining Lane type (Ingress/Egress).

FIG. 33 is for one embodiment of the invention, for a system ofdetermining the approach set for every lane.

FIG. 34 is for one embodiment of the invention, for a system ofdetermining connecting lanes and movement state for ingress lane.

FIG. 35 is for one embodiment of the invention, for a system of MAPGeneration. Improved map generation uses signal data available fromtraffic controller.

FIG. 36 is for one embodiment of the invention, for a system of Mapmaintenance. Abnormal traffic condition is detected by observing thevehicle density profile and the vehicle path matching performance.

FIG. 37 is for one embodiment of the invention, for a system of Mapmaintenance. Improved map maintenance uses signal data from trafficcontroller.

FIG. 38 is for one embodiment of the invention, for a system of Mappublishing, storing, and updating mechanism.

FIG. 39 is for one embodiment of the invention, for a system of SafetyConsideration.

FIG. 40 is for one embodiment of the invention, for a system ofcreating, storing, and updating local dynamic MAP database with safetyattribute.

FIG. 41 is for one embodiment of the invention, for a system, forpedestrians moving at the intersection for a road.

FIG. 42 is for one embodiment of the invention, for a system, fordirection, for the angle with respect to the coordinate system, with N-Eaxes.

FIG. 43 is for one embodiment of the invention, for a system, fordirection, for the intended intersection paths, for possibilities.

FIG. 44 is for one embodiment of the invention, for a system, forpedestrian speed, before and after the stop.

FIG. 45 is for one embodiment of the invention, for a system, forpedestrian movement, for positions, plus position at rest.

FIG. 46 is for one embodiment of the invention, for a system, forpedestrian acceleration, with consistent behavior, plus deceleration tostop.

FIG. 47 is for one embodiment of the invention, for a system, for angle,before the stop, plus the delta angle, or the difference in angle.

FIG. 48 is for one embodiment of the invention, for a system, for angle,during the stop.

FIG. 49 is for one embodiment of the invention, for a system, for yawrate.

FIG. 50 is for one embodiment of the invention, for a system, for yawrate integration.

FIG. 51 is for one embodiment of the invention, for a system, foracceleration measurements.

FIG. 52 is for one embodiment of the invention, for a system, forintended intersection paths.

FIG. 53 is for one embodiment of the invention, for a system, forposition at move and position at rest.

FIG. 54 is for one embodiment of the invention, for a system, for yawrate and yaw rate integration.

FIG. 55 is for one embodiment of the invention, for a system, forcommunications between and from telephone company and satellite, to/fromperson's mobile phone or device, as well as the moving car, to connectthe car with the mobile device/phone/smart phone, for understanding theposition(s) of the pedestrian(s) at the intersections for the roads, bythe moving car, nearby.

FIG. 56 is for one embodiment of the invention, for a method ofimplementation of tracking pedestrian heading angle using smart phonesdata for pedestrian safety applications.

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

Here, we describe some of the embodiments of our system and method:

Let's look at the details of one method:

MAP Generation: MAP Generation based on vehicle data, included in BasicSafety Message (BSM) or equivalent message(s).

-   -   a. Listen to all the BSMs transmitted in the given region, and        based on what is the intended region of map, filter out the BSM        data which falls outside this region. The intended region of map        can also be defined adaptively, using the speed profiles data in        each road segment of interest. For example, a high average speed        road segment will require more map coverage than a low average        speed road segment.    -   b. Store location (concise), Heading, Speed, and timestamp of        each of the BSM.        -   If the vehicle provides PH (Path History or trajectory or            breadcrumb trail points) (concise points), check the            accuracy/confidence of the PH points. In case the accuracy            is good (say better than e.g. 0.4 m (or meter)), store them            instead of actual locations reported by the vehicle.            -   For example, from the current location and velocity, we                can calculate the next point in time, or we can                extrapolate the next point, based on the last N points.                For example, one can assume a line or higher order                curves, or polynomials of degree M, to fit the points in                the formula and get the coefficients. Once the                coefficients are known, the next point can be                extrapolated.            -   For example, the accuracy can be measured from the                distance of a given point to the line or curve of                trajectory.            -   For an embodiment, the accuracy threshold is a fixed                number or distance.            -   For an embodiment, the accuracy threshold is a variable                number or distance. That can be dependent on the                velocity of the vehicle. For example, the higher the                velocity, the higher the threshold, e.g., with a linear                relationship.        -   Otherwise, use the location details provided by the vehicle            and generate the PH (Concise) points for the vehicle, and            store these values.    -   c. Start generating a Temporary Map, once the stored data has        sufficient number of vehicles, Q (say, e.g., 1000 vehicles), or        for example, length of time for monitoring, T, as a threshold,        e.g., one-week worth of data, to make sure we have enough data        points for our analysis and determination. In one embodiment, we        can use any logical combination of thresholds or conditions on Q        and T, e.g., using AND or OR.

Here are the steps of one embodiment of our method: (see FIG. 27)

Step 1: Generating Lanes: (see FIGS. 18-19)

-   -   Assign equal weights for all the paths at the start, as the        initialization step.    -   Combine the Paths (or parts of paths) which have a separation        distance of lesser than a fraction of a lane width, say, e.g.,        ¼th of the Lane width, or e.g., 0.5 meter, as the threshold for        this step, to indicate that those are in fact the same. The        weight of the resultant path is calculated using the combined        statistic method similar to the one used in Kalman filtering.        -   e.g., Resultant Weight:

(w_r) =  = 1/sqrt[((1/w 1)² * (1/w 2)²)/((1/w 1)² + (1/w 2)²)]

-   -   -   Where sqrt is the square root function, w1 is the weight of            the first path, and w2 is the weight of the second path.        -   Another method is to use the first order statistical            combination.        -   Then, we have:

w _(—) r=1/(((1/w1)*(1/w2))/((1/w1)+(1/w2)))

-   -   -   In general, we have as a function (F) of w1 and w2:

w _(—) r=F(w1, w2)

-   -   First, combine the paths which start and end with the same        heading angles.    -   Second, combine the parts of paths of the vehicles which have        the same headings in that part.    -   For the combined paths which are headed in the same direction,        update the weights (using the above formula) of the paths (or        parts of the paths).    -   Detect Lane changes in the captured/stored data, and discard        that data (either part or full info from that vehicle).        Different methods of detecting lane changes have been proposed        in previous inventions (see the parent applications). Any of        those methods can be used here for the detection of lane        changes.    -   In addition, the statistical Median operation can be also used        to filter outliers in positions and paths. It also can help for        the lane change detection.    -   In one embodiment, generally, the outliers may be bad data        points, and cannot be relied on. So, we filter them out. In one        embodiment, assuming the normal distribution, if any data point        is beyond 2 standard deviations, from the peak, it is considered        as the outlier point, and gets discarded.    -   In one embodiment, a vehicle is monitored from its center, as a        point, for tracking purposes.    -   In one embodiment, a vehicle is monitored from the middle front        point and the middle back point, as 2 points, for tracking        purposes. So, for example, if one point (e.g. the front point)        is in one lane and the other point is in another lane, that may        indicate transition between lanes or changing lanes, if the        difference is above a threshold, which is measured with respect        to the distance perpendicular to the lane direction, or with        respect to the angle relative to the lane direction.

Step 2: Determining Intersection Region and Splitting the lanes: (seeFIGS. 20-23)

Intersection Diamond region can be identified from the above data in thefollowing ways: (see FIG. 28)

1. Using Speed profiles of the vehicles.

2. Using Heading angles of the vehicles.

3. Using Intersection of Lanes (generated from Vehicle Travel paths).

Now, let's look at different methods in details:

Method 1: Using Speed Profiles of the vehicles: (see FIGS. 20-22)

-   -   For each of the lanes, consider the stop location of all the        vehicles traversing on that lane.    -   Of these locations, discard the locations where the vehicle        stays for lesser than a short time period t₁, say e.g. 5 sec.        (As these could have been recorded due to vehicle slow motion,        and would not have the time for GPS stabilization. So, they        should be discarded.)    -   Of all these locations, using statistical methods, e.g. using        standard-deviation method, neglect the outliers (e.g. 5%        outliers), or e.g., discard the tail of the probability        distribution on either side, as e.g., extreme cases or        unreliable cases.    -   Consider vehicle travel direction on the road (based on        locations and timestamps), and pick up the location which comes        farthest and toward the exiting end of the lane, as P_(far).    -   Pick up all the locations which lay within distance L₂ of        P_(far), say e.g. within 7 m of the selected location, or A₃.        Calculate the percentage of vehicles in this circle or region.        If the percentage of vehicles in this circle or region is below        S ₁, say e.g. 7% of the total vehicle locations on this lane,        then discard the selected location and reconsider above step for        selecting a location.    -   If Vehicle lengths are known, use them, as L₃, else use        L_(default), e.g. 5 m, as typical length, and then calculate the        average of vehicle lengths. (We can eliminate this step and use        5 m, directly, if required, or if not enough data is available        from the vehicles.)    -   Construct average of locations based on average of GPS location        of all vehicles which fall within area A₃, or the 7 m radius of        the selected location.    -   Calculate the GPS location of the point which falls ahead of the        above average-of-locations, at a distance of a fraction of the        typical vehicle length, or S₂, e.g. half (or 55 percent) of        average vehicle length.    -   The GPS location of each of the lanes, constructed based on the        above steps, provides the outer edge of the Intersection Diamond        region.

This applies on other road segment of interest, that show queue ofvehicles stopped, with profile history of coming to stop. Another way tolook at it is to detect an area where there is no stopped vehicleposition density. (This is the intersection diamond region.)

Method 2: Using Heading angles:

-   -   Consider all the vehicles which are traversing on each of the        lanes.    -   Of the vehicles traversing on each lane, select the vehicles        which have executed a change in the Heading angle (by more than        α₁, e.g. 20°), where some of the other vehicles near to that        location were traveling straight.    -   Of all the above selected vehicles, select the location where        they executed this change.    -   Of all these locations, discard the outliers which fall outside        of e.g. 5% of the statistical limit, or tail of the distribution        curve, as anomalies or outliers.    -   Calculate the average of these remaining locations. This average        location provides the lane boundary of the selected lane.        -   In one embodiment, the average is based on average of X and            Y coordinates, on 2-D coordinates.        -   In one embodiment, the average is based on weighted average            of X and Y coordinates, emphasizing some data over the            others. For example, one can have more weights for more            reliable data.    -   The GPS location of each of the lanes, constructed based on the        above steps, provides the outer edge of the Intersection Diamond        region.

Method 3: Using Intersection of Lanes (generated from Vehicle Travelpaths): (see FIG. 23)

-   -   For each of the lanes which differ in heading angle by more than        angle α₃, say e.g. 30°, construct the Intersection point of the        lines (lanes).

2In one embodiment, angle α₃ can be adjusted based on historical data,as a threshold value.

-   -   -   In one embodiment, angle α₃ can be randomly selected from            the range of 25° to 35°.

    -   Construct a convex polygon using these points (or a subset of        them) which can cover all the points.        -   In one embodiment, for a subset of points, choose every            other point.        -   In one embodiment, for a subset of points, choose one point            out of every 3 points.        -   In one embodiment, for a subset of points, choose one point            out of every N points. (N is an integer above 3.)        -   In one embodiment, to define a convex polygon using these            points, we look at the current side and 2 previous sides of            the polygon, labeled P₁, P₂, and P₃, respectively, as            vectors. The difference between the directions of vectors            (P₁ and P₂) and (P₂ and P₃) are angles α₄ and α₅,            respectively. If both angles α₄ and α₅ are in the same            directions (e.g. both tilted clockwise, with respect to the            previous vector), then the resulting polygon is a convex            one.

    -   Expand the Convex polygon by adding a certain amount of width,        e.g. a fraction (g₁) of the lane width (say e.g. half of the        lane width) on each of the sides.

    -   Split the lanes, based on the intersection region polygon.

Step 3: Determining Lane type (Ingress/Egress): (see FIG. 24)

We use the following methods:

Method 1: Using difference in angle in Vehicle heading and Lane-Heading(Waypoint0):

-   -   For each of the lanes, calculate the angle of Waypoint0 (w.r.t.

Waypoint1).

-   -   Calculate the difference in heading of Waypoint0 and Heading of        vehicle (α₆).    -   If the Difference α₆ falls between say, e.g., {[0°-90° ] U        [270°-360°]}, as the union of sets or ranges of angles (or the        angle locating in the union of the first and fourth quadrants in        the 2-D coordinate system), then given lane is an Egress lane,        else (otherwise), it is an Ingress lane.    -   Based on the vehicles heading angle at the 1st waypoint (closest        to intersection region), we decide on whether the Lane is an        Ingress or Egress.

Method 2: Based on vehicle movement inside the Lane:

-   -   Using the location of vehicle and its corresponding time-stamp,        determine whether Vehicle is approaching Waypoint0, or leaving.

Step 4: Determining Approach Set for each of the lanes: (see FIG. 25)

-   -   Combine the (incoming/outgoing) lanes which fall on one side of        the polygon and have either same (or) exactly opposite heading        angle (diff. approximately 180°).

Step 5: Determining connected Lanes: (see FIG. 26)

-   -   For each of the Ingress lanes, observe the movement (mapping of        incoming lanes to outgoing lanes) of each of the vehicles in        that lane.    -   Create a Mapping list for the selected Ingress lane, and count        the vehicles traversing each of these connections.    -   Discard the outliers (connections) where the vehicles traverse        less than e.g. 5% of the total vehicles in that lane.    -   Using relative heading angle between the Ingress lane and        Connecting-Egress lane (α₇), determine whether a        Left/Right/Straight (L/R/S) maneuver is required to enter the        connecting-Egress lane.        -   In one embodiment, we compare the angle α₇ with a threshold            angle α₈. If absolute value of α₇ is smaller than or equal            to α₈, then we call it Straight. If absolute value of α₇ is            bigger than α₈, then, e.g.:            -   For positive α₇ values, we call it Right.            -   For negative α₇ values, we call it Left.

Step 6: Determining Movement states for each Ingress lane:

-   -   For each of the Ingress lanes, based on the Connected-Egress        lane's Maneuver code, determine the Movement state. Say, for        example, the possible connection maneuvers are Left-Turn (LT),        Straight (S), and then the Movement states are: LT movement, S        movement.

MAP Generation: Improvement to above described method in steps 1-6 withan additional Signal Data available from Traffic controller. (see FIG.40)

The Idea in this method is to match Traffic controller's signal-phasedata with vehicles' motion in each of the lanes and determine the signalphase for each of the Lane/Approach. Here is how it works:

-   -   Continuously poll Traffic-controller for the Signal status        information.    -   When Traffic-controller is stating a particular phase number for        the first time, during next short period of time, t₂, e.g. 1-5        seconds, identify the lanes in which vehicles started moving        from a halt.    -   Of these lanes, identify the direction of travel of the vehicles        in each ingress lane towards their egress lanes, and determine        the Phase-number for that lane corresponding to that Movement        state.    -   For each of the Signal-phase mapped to the Ingress lane, count        the number of vehicles using that phase to cross the Diamond        region, N₁.    -   Eliminate the Outlier, e.g. 5% of the phases (if any), or the        tail of the distribution, from the above list of phases for each        of the Ingress lanes, resulting in a smaller number (N₂).

MAP Maintenance: Based on BSM messages(s) or equivalent vehicle message.(see FIG. 40)

-   -   Removal of (or repair work in) a Lane: When the density of the        vehicles in a particular lane drops off drastically (e.g., more        than a percentage or ratio of the original number, e.g., more        than N₃ percentage), and adjoining lane increases in a similar        manner (e.g., more than a percentage or ratio of the original        number, e.g., more than N₄ percentage).        -   A vehicle breakdown is detected in that lane. (Or)        -   The lane is temporarily closed. (Or)        -   The lane is permanently closed. (Or)        -   A detour is assigned for that lane. (Or)        -   There is an accident in that lane. (Or)        -   Almost all the vehicles in that lane have been detected to            do a lane change to adjacent lane(s) before a certain point            (coordinates X, Y in 2D space). (Or)        -   No vehicles were detected in that lane over a period of            time, t₃, e.g. 2 hours, while on a similar time frame over a            past couple of days, or N_(past) past number of days, we had            a greater number of vehicles using that lane,            percentage-wise with respect to all vehicles on the road, or            using an absolute number, e.g., N_(abs), e.g. 50.            -   The exception is for holidays and weekends, which have                different traffic patterns. So, we do not include them                for comparison with weekdays. So, for comparison, we                have different classes, e.g.: working day class, weekend                class, and holiday class, which correspond to different                days and traffic patterns and human behaviors.            -   For example, during weekends, at 6 am, the lanes may be                empty or almost empty, but there is no accident or                broken down car in any lane. So, it cannot be compared                with a period of rush-hour at 6 am during weekdays/ work                days. So, each class should be compared within/with                itself.            -   For example, during different seasons, e.g. winter, the                ice and snow may slow down the cars. Thus, those days                cannot be good base of comparison for a sunny day in                Summer. So, they constitute a new class of days with                different traffic patterns and behavior. So, they should                be compared with similar days with similar                situations/classes.    -   Removal of (or repair work in) an Approach: When, e.g., the        density of the vehicles in a particular approach road decreases.        -   For example, a major pileup (breakdown in multiple/all            lanes) has been detected.        -   For example, the road is closed and a detour is assigned.        -   No vehicles were detected in that lane over a period of            time, while the same time previous days had a considerable            number of vehicles passing through that approach.            -   One can specify the previous number of days, N.            -   One can specify the number of hours or window of hours,                e.g., from 12:00 to 16:00, or from 12 noon to 4 pm, for                monitoring the traffic.            -   One can specify the considerable number of vehicles (as                a threshold), or number of cars in general, as the                absolute number or ratio of numbers or percentage of                total, e.g., 50 cars, or 50 cars/hour, or 5 times more                cars than yesterday for the same time period, or 50                percent more cars than yesterday for the same window of                time or rush hours, or 1.2 times more cars than 2 hours                ago, or 50 more cars than 2 hours ago, or 50 cars/minute                more cars than 2 hours ago (as the rate comparison), or                50 percent more cars/minute than 2 hours ago (as the                rate comparison), or 1.2 times more cars/minute than 2                hours ago (as the rate comparison).            -   The season, holidays, weekends, weather-related events,                and work days are considered, to define different                classes of the days, hours, traffic patterns, or human                bahaviors, for comparison purposes, as the base line, or                find anomaly, or find road condition, or determine                traffic status, or prepare maps, or modify maps.            -   Historical data can be accumulated for a region or                specific road to get the patterns for traffic or                behavior, e.g., to predict the future or scale the                results or numbers for a specific condition. For                example, for rainy days, the speeds are reduced by a                factor of 30 percent.            -   For different roads, one can define different classes,                for which the same pattern is observed, or there is a                common parameter or property. For example, the 4-lane                interstate highways, near a major city, may show a                similar traffic pattern or traffic jams, or they may                have same general traffic speed. So, we define a class                for these highways, which historically or statistically                behave similarly, in one or more aspects or parameters.                Then, for a given class member, if we get a data for a                specific time/day, e.g., for speed of vehicles, and                e.g., it shows 20 percent lower speed with respect to 1                hour ago, then one can assume the same for other members                of the same class for the same time period, which is                useful to estimate the speed for other highways, or make                the data analysis faster, even if we have no data or                incomplete data from other members of class (other                highways of the same class), which probably gives us a                reasonable starting point or base line or data point,                especially in the absence of data or reliable data from                other highways of the same class.    -   Updating Waypoints of a Lane: When vehicle-Matching is either        continuously failing or having a correction values above e.g. 20        cm, or a threshold distance, D. Note that D can be defined based        on a fraction of lane width or average car length, or percentage        or ratio of those parameters.        -   Do a Lane-matching for all the vehicles traversing in the            Mapped region.        -   For each of the Lane, calculate the average lateral-offset            values each of the vehicles is having in each segment of the            Lane.        -   If the lateral offsets are greater than, D_(w), e.g. 20 cm,            for particular contiguous waypoints, add additional            waypoints in between the existing waypoints, based on            average location or X-Y 2D coordinates (discarding outliers,            e.g. 5 percent outliers, anomalies, or tails of distribution            curve) of recent-vehicles traversing in that lane-segment,            e.g. recent 15 minutes or 1 hour.            -   In one embodiment, D_(w) is defined e.g. based on lane                width or average vehicle length or width.

MAP Maintenance: Improvement to above method with additional Signal Dataavailable from Traffic Controller. (see FIG. 40)

-   -   Keep a continuous monitor on the Vehicle traversals using each        of the Signal phases.    -   Verify if the existing Matching of the Signal-Phases and the        Vehicle motions in each of the active lanes are still valid.    -   Neglect the outlier in the matching, e.g. the 5 percent        extremes, but if the matching provides a consistent        “inconsistencies” in the matchings, update the Signal-Phase and        Lane-Movement states matching.

MAP publishing, storing, and updating mechanisms: Broadcasting MAPinformation. (see FIG. 40)

Each of the RSE/Remote-Server would have 2 MAPS for each location,namely, Base-Map and Look-aside (Current-status) MAP.

Case 1: No Base map is available (initial condition):

-   -   For a Look-aside MAP, once the MAP has sufficient number of        vehicle (say e.g. 100) traversals on each of its lanes, consider        it for further calculations.    -   Once the above limit is reached, execute a Map-matching of        vehicles with Look-aside MAP, and determine the match percentage        or ratio. Average the matching percentage for all the vehicles.    -   If the Match-percentage is high (say e.g. above 99%), upgrade        the Look-aside database at that instant to Base-MAP. Case 2:        Base Map is available (updating condition):    -   Compare the Base Map with Look-aside MAP for following        differences:        -   Lateral distance shifts in the Waypoints of the lane: Ignore            them if the shift is less than D_(s), e.g. 20 cm, or a            threshold distance.            -   In one embodiment, D_(s) is defined e.g. based on lane                width or average vehicle length or width, or based on                D_(w). For example, D_(s) is set equal to D_(w).            -   In one embodiment, D_(s) is adjusted based on historical                data, or corrected by human expert periodically.        -   Connection lane changes: Changes in possible maneuver codes            of the lane and the connected lane lists.        -   Change in Signal-Phase matching.    -   In case the changes in the Base-Map and Look-aside Map are        considerable (above a threshold), and base Map is failing to        provide high-Map-matching results, while Look-aside MAP is able        to provide high MAP-Matching results, consider upgrading        Look-aside MAP in the following criteria:        -   Manual override is detected for upgrading existing            Look-aside MAP.        -   The difference is seen consistently for more than e.g. a            Day, or a specific time period T_(C), and there are            sufficient numbers of vehicles, N_(V) (say e.g. 1000), in            each of the lanes, for proper statistics and analysis.            Cherry pick these differences and update them in Base-Map.            Decreasing Computations and increasing confidence in            MAP-Generations: (see FIG. 40)

Some minimal information, when available, could be manually fed to thesystem allowing the system to identify vehicle movements accurately andgenerate better results, in a shorter time period. For example:

-   -   Approach Count, and Approach names    -   Lane numbers in each Approach and Lane-widths    -   Cross-Walks    -   Traffic controller-information (to which system to poll and get        results)    -   Approximate intersection-Diamond region dimensions, or        average/typical of those dimensions from other locations

Safety Consideration:

Detecting an idle vehicle (or Breakdown vehicle or accident vehicle or aclosed lane) and share the location of this vehicle with other vehiclesmake this concept of map extend, to have a safety attribute.

FIG. 18 is for one embodiment of the invention, for step 1, generatinglanes. FIG. 19 is for one embodiment of the invention, for step 1,generating lanes. FIG. 20 is for one embodiment of the invention, forstep 2, constructing INTX Diamond Region. FIG. 21 is for one embodimentof the invention, for step 2, constructing INTX Diamond Region. FIG. 22is for one embodiment of the invention, for step 2, constructing INTXDiamond Region. FIG. 23 is for one embodiment of the invention, forMethod 3, using lane intersections. FIG. 24 is for one embodiment of theinvention, for step 3, determining lane type. FIG. 25 is for oneembodiment of the invention, for step 4, determining approach set.

FIG. 26 is for one embodiment of the invention, for step 5, determiningconnection set. FIG. 27 is for one embodiment of the invention, for asystem of creating, storing, and updating local dynamic MAP databasewith safety attribute. FIG. 28 is for one embodiment of the invention,for a system of creating, storing, and updating local dynamic MAPdatabase with safety attribute.

FIG. 29 is for one embodiment of the invention, for a system of mapgeneration. It generates maps using vehicle data such as location,speed, and heading, along with time stamp. It identifies map regionusing speed profile data collected on each road segment. It builds pathhistory for each vehicle data. It generates temporary map when enoughdata is captured.

FIG. 30 is for one embodiment of the invention, for a system of lanegeneration. It constructs lanes by clustering vehicles path andcombining vehicle paths inside the clusters. It clusters vehicle pathsusing separation distance. It combines vehicle path using statisticalweighting method. It combines vehicle path using heading angle data. Itfilters the data that belongs to lane change event.

FIG. 31 is for one embodiment of the invention, for a system ofdetermining intersection and lanes splitting. It determines intersectionregion using vehicles speed profiles, vehicles heading angles, andvehicles travel path intersects. It detects when and where vehicles havestopped. Stopped vehicles locations are correlated with the lanes exitlines. It detects vehicle locations where significant change in theheading has occurred. It identifies intersection region of movingvehicle paths with significant heading angle difference approach. Itconstructs convex polygon. It splits lane using the polygon region.

FIG. 32 is for one embodiment of the invention, for a system ofdetermining Lane type (Ingress/Egress). It determines “Ingress/Egress”lane type using correlation between vehicle heading and lane heading,and vehicle motion inside the lane.

FIG. 33 is for one embodiment of the invention, for a system ofdetermining the approach set for every lane. It determines the approachset for every lane by combining the incoming and outgoing lanes thatfall on one side of the polygon and have similar or opposite headingangle.

FIG. 34 is for one embodiment of the invention, for a system ofdetermining connecting lanes and movement state for ingress lane. Itdetermines connected lanes by observing vehicles motion along ingressand egress lane. It determines the maneuver type to go between ingressand egress (left/right/straight).

FIG. 35 is for one embodiment of the invention, for a system of MAPGeneration. Improved map generation uses signal data available fromtraffic controller. It correlates the traffic controller signal phasedata with the vehicle motion status (e.g., as: “is going to stop”, “hasstopped”, “is moving from stop”, “moving”, and etc.).

FIG. 36 is for one embodiment of the invention, for a system of Mapmaintenance. Abnormal traffic condition is detected by observing thevehicle density profile and the vehicle path matching performance.Different types of conditions that cause the abnormality are detected,such as idle vehicle, accident, work zone, or even a permanent ortemporary change in the road.

FIG. 37 is for one embodiment of the invention, for a system of Mapmaintenance. Improved map maintenance uses signal data from trafficcontroller. It verifies that existing matching between vehicle motionand signal phase data for each lane is still the same.

FIG. 38 is for one embodiment of the invention, for a system of Mappublishing, storing, and updating mechanism. Two maps are stored: basemap and look aside map. At initialization, no base map is available.Look aside map can be moved to base map when enough confidence is built.The look aside replaces the corresponding part of the base map when itsconfidence level becomes better than the base map.

FIG. 39 is for one embodiment of the invention, for a system of SafetyConsideration. It detects an idle vehicle (breakdown vehicle) and sharesthe location of this vehicle with other vehicles, for map, to have asafety attribute.

An embodiment of the invention is a method for creating, storing, andupdating local dynamic map database with safety attribute, for a streetor highway, said method comprising: a central computer receiving speedprofiles from vehicles in said street or highway from an input device;an analyzer module or device determining vehicular density for saidvehicles in said street or highway; an identifier module or devicedetermining lane attributes for a lane in said street or highway;receiving traffic controller data for said street or highway;integrating said traffic controller data for said street or highway intomap data; identifying temporary and permanent changes in said map data;updating said map data; and identifying an obstacle of mobilityattribute in said map data.

An embodiment of the invention is one of the following:

-   -   identifying intersections for said street or highway.    -   identifying an idle vehicle in said street or highway.    -   identifying an accident in said street or highway.    -   using a short range communication device.    -   using an on-board device in a car.    -   using a road side equipment.    -   determining a status of said traffic controller data.    -   determining a correlation with a status of said traffic        controller data.    -   storing said map data.    -   generating a basic safety message.    -   storing location, heading, and speed of a car.    -   storing a time-stamp for a basic safety message.    -   checking an accuracy of past history points.    -   generating lanes for said street or highway.    -   combining paths for said street or highway.    -   using statistical analysis for paths.    -   using weights for paths.    -   detecting a lane change event.    -   filtering outlier samples in statistical analysis.

In one embodiment, the map can be generated in a central processor. Inone embodiment, the map can be generated in distributed processors, andlater merged together as one map. The advantage of thedistributed-processors method is that if for any reason thecommunication or the processing is interrupted, the other processors canpartially supply the data for the vehicles, for navigation andoperation. In one embodiment, the processor is mobile itself, e.g.,installed in a car, satellite, drone, balloon, or airplane. In oneembodiment, the processor is stationary, at a fixed location. In oneembodiment, the processor network manages the map, e.g., in a serverfarm.

In one embodiment, each server covers one part of the city or area. Inone embodiment, the geographical areas have overlaps for coverage. Inone embodiment, there are redundancies between coverage of differentunits. In one embodiment, there is a correction based on theredundancies between coverage of different units, to find and filter outthe erroneous data. In one embodiment, there is an averaging processbased on the redundancies between coverage of different units, toaverage the data for more accurate results. In one embodiment, there isa weighted-averaging process based on the redundancies between coverageof different units, to weighted-average the data for more accurateresults, with more weights for the more reliable units or sources, orhigher weights for the results that are closer to the center of curverepresenting the distribution of values, i.e., eliminating or reducingthe fringe results or erroneous data.

In one embodiment, we have data distributed and sold to a third partysubscribing to our service and data flow, as updates and feed, so thatthey can manage the traffic or control cars or analyze the data formarketing purposes or finding the trends. For example, from the trafficpatterns, one can conclude that how many cars are going to the new mallor store and how long they stay at that mall in average, in terms ofhours, and at what hours or which days, which will help the mall to planfor marketing and sales, e.g., to order merchandise in advance forspecific people or specific time or season. In addition, from thetraffic pattern, one can conclude that which areas or streets are mostlikely the source of cars to a specific mall or region, statistically,so that from the social or income data from a target neighborhood, onecan find the social or income level of people likely going to a specificmall, and at what time during the day, as a probability distribution, sothat the average, or median, or aggregate, or expected value, orstandard deviation can be extracted or estimated for each parameterunder study, e.g., income level or average age or gender, e.g., astay-home or vacationing parent driving to mall during day time onweekdays (e.g., not working at an office or regular job or vacationing,so that have enough time during the day to go to mall during weekdaysand non-holidays). Such estimates and statistics for patterns orbehaviors for people are very valuable for marketing and sales peoplewho want to predict and plan ahead. Thus, they buy these data andanalyze and extract patterns from them for their specific purposes.

Another purpose or usage for such data is for traffic planning or cityexpansion planning or metro rail planning for future, e.g., to removecongestion or reduce traffic around main roads or plan for gas stationsor malls or office buildings or metro stations or train stations, orestimate the trend for population growth or movement or concentrationthroughout the years, by comparing such traffic data in time, e.g., toplan schools for future for a district. Aggregate and trend anddirection results are very useful and valuable for people in charge ordecision makers for all of the private and public sectors. For example,for heavily congested and concentrated intersections and roads, the realestate market and values may go up, due to demand for commercial spaceand office space. Or, the parking fee rate per hour or per day may goup, due to the demand or shortage for parking space, at least during thetime that are the peak for traffic, from our data collected for varioustimes and regions.

Here, we describe some of our embodiments/ examples, as components ofour system:

Map Generation: (See FIG. 29)

-   -   It generates maps using vehicle data such as location, speed,        and heading, along with time stamp.    -   It identifies map region using speed profile data collected on        each road segment.    -   It builds path history for each vehicle data.    -   It generates temporary map when enough data is captured.

Generating Lanes: (See FIG. 30)

-   -   It constructs lanes by clustering vehicles path and combining        vehicle paths inside the clusters.    -   It clusters vehicle paths using separation distance.    -   It combines vehicle path using statistical weighting method.    -   It combines vehicle path using heading angle data.    -   It filters the data that belongs to lane change event.

Determining Intersection and Lanes Splitting: (See FIG. 31)

-   -   It determines intersection region using vehicles speed profiles,        vehicles heading angles, and vehicles travel path intersects.    -   It detects when and where vehicles have stopped.    -   Stopped vehicles locations are correlated with the lanes exit        lines.    -   It detects vehicle locations where significant change in the        heading has occurred.    -   It identifies intersection region of moving vehicle paths with        significant heading angle difference approach.    -   It constructs convex polygon.    -   It splits lane using the polygon region.

Determining Lane Type (Ingress/Egress): (See FIG. 32)

-   -   It determines “Ingress/Egress” lane type using correlation        between vehicle heading and lane heading, and vehicle motion        inside the lane.

Determining the Approach Set for Every Lane: (See FIG. 33)

-   -   It determines the approach set for every lane by combining the        incoming and outgoing lanes that fall on one side of the polygon        and have similar or opposite heading angle.

Determining Connecting Lanes and Movement State for Ingress Lane: (SeeFIG. 34)

-   -   It determines connected lanes by observing vehicles motion along        ingress and egress lane.    -   It determines the maneuver type to go between ingress and egress        (left/right/straight).

More in MAP Generation: (See FIG. 35)

-   -   Improved map generation uses signal data available from traffic        controller.    -   It correlates the traffic controller signal phase data with the        vehicle motion status (e.g., as: “is going to stop”, “has        stopped”, “is moving from stop”, “moving”, and etc.).

Map Maintenance: (See FIG. 36)

-   -   Abnormal traffic condition is detected by observing the vehicle        density profile and the vehicle path matching performance.    -   Different type of conditions that causes the abnormality are        detected, such as idle vehicle, accident, work zone, or even a        permanent or temporary change in the road.

More in Map Maintenance: (See FIG. 37)

-   -   Improved map maintenance uses signal data from traffic        controller.    -   It verifies that existing matching between vehicle motion and        signal phase data for each lane is still the same.

Map Publishing, Storing, and Updating Mechanism: (See FIG. 38)

-   -   Two maps are stored: base map and look aside map.    -   At initialization, no base map is available. Look aside map can        be moved to base map when enough confidence is built.    -   The look aside replaces the corresponding part of the base map        when its confidence level becomes better than the base map.

Safety Consideration: (See FIG. 39)

-   -   It detects an idle vehicle (breakdown vehicle) and shares the        location of this vehicle with other vehicles, for map, to have a        safety attribute.

Description of the Overall System

Here, we describe the overall/ general system for some of ourembodiments above:

FIGS. 1-9 describe in details the presented automated vehicle system.FIGS. 10-17 explain some embodiments of the current invention. FIG. 1 isfor one embodiment, as an example, for representation of development offully automated vehicles, in stages, for progression toward fullyautomated vehicles. FIG. 2 is for one embodiment of the invention, for asystem for automated vehicles, using GPS, independent sensors, maps,driving dynamics, and sensor fusions and integrations.

FIG. 3 is for one embodiment of the invention, for a system forautomated vehicles, with different measurement devices, e.g., LIDAR(using laser, scanner/optics, photodetectors/sensors, andGPS/position/navigation systems, for measuring the distances, based ontravel time for light), radar, GPS, traffic data, sensors data, orvideo, to measure or find positions, coordinates, and distances. Thegovernment agencies may impose restrictions on security and encryptionof the communications and data for modules and devices within thesystem, as the minimum requirements, as the hackers or terrorists maytry to get into the system and control the vehicles for a destructivepurpose. Thus, all of the components are based on those requirementsimposed by the US or other foreign governments, to comply with thepublic safety.

FIG. 4 is for one embodiment of the invention, for automated vehiclefunctional architecture, for sensing, perception, applications, andactuation. FIG. 5 is for one embodiment of the invention, for automatedvehicle infrastructure architecture, for sensing, gateway, and services.

FIG. 6 is for one embodiment of the invention, for a system for V2Xlandscape, with components, for spectrum and range of frequencies andcommunications, for various technologies, for various purposes, fordifferent ranges. FIG. 7 is for one embodiment of the invention, for asystem for framework for V2I applications, with components, forroad-side platform and on-board platform, using various messages andsensors.

FIG. 8 is for one embodiment of the invention, for a system forautomated vehicle command and control (C2) cloud, with components, withvarious groups and people involved, as user, beneficiary, oradministrator. FIG. 9 is for one embodiment of the invention, for asystem for our (Savari) C2 network, with components, showingcommunications between networks and vehicles, using traffic centers'data and regulations by different government agencies.

In one embodiment, we have the following technical components for thesystem: vehicle, roadway, communications, architecture, cybersecurity,safety reliability, human factors, and operations. In one embodiment, wehave the following non-technical analysis for the system: public policy,market evolution, legal/liability, consumer acceptance, cost-benefitanalysis, human factors, certification, and licensing.

In one embodiment, we have the following requirements for AV (automatedvehicles) system:

-   -   Secure reliable connection to the command and control center    -   Built-in fail-safe mechanisms    -   Knowledge of its position and map database information (micro        and macro maps)    -   Communication with traffic lights/road side infrastructure    -   Fast, reliable, and secure    -   Situational awareness to completely understand its immediate        surrounding environment    -   Requires multiple sensors    -   Algorithms to analyze information from sensors    -   Algorithms to control the car, for drive-by-wire capability

In one embodiment, we have the following primary technologies for oursystem:

-   -   V2X communication: time-critical and reliable, secure, cheap,        and dedicated wireless spectrum    -   Car OBE (on-board equipment): sensor integration (vision, radar        and ADAS (advanced driver assistance system)), positioning        (accurate position, path, local map), wireless module (physical        layer (PHY), Media Access Control (MAC), antenna), security        (multi-layer architecture), processing and message engine, and        algorithms for vehicle prediction and control

In one embodiment, we have the following building blocks for AVs:

-   -   Automation Platform        -   i. Advanced Driver Assistance (ADAS) integration        -   ii. Map Integration, Lane Control        -   iii. Radio communications support        -   iv. Vehicle Controller Unit to do actuation    -   Base Station    -   Ground positioning support to improve positioning accuracy    -   V2I (vehicle to infrastructure) functionality, support for        public/private spectrums    -   Cloud connectivity to provide secure access to vehicles    -   Command Control Center        -   i. Integration with Infrastructure Providers

Here are some of the modules, components, or objects used or monitoredin our system: V2V (vehicle to vehicle), GPS (Global PositioningSystem), V2I (vehicle to infrastructure), HV (host vehicle), RV (remotevehicle, other vehicle, or 3^(rd) party), and active and passive safetycontrols.

FIG. 10 is for one embodiment of the invention, for a system for hostvehicle, range of R values, region(s) defined, multiple nodes orvehicles inside and outside region(s), for communications betweennetworks and vehicles, and warning decisions or filtering purposes, forvarious filters to reduce computations and reduce the bandwidth neededto handle the message traffic. FIG. 11 is for one embodiment of theinvention, for a system for host vehicle, range of R values, region(s)defined, for an irregular shape(s), depending on (x,y) coordinates in 2D(dimensional) coordinates, defining the boundaries, or in 3D forcrossing highways in different heights, if connecting.

FIG. 12 is for one embodiment of the invention, for a system forautomated vehicles, with components, with one or more filtering modules,based on coordinates, Rs, GPS, and maps, and their correspondingcorrections. FIG. 13 is for one embodiment of the invention, for asystem for automated vehicles, with components, with a function F( ),e.g., depending on the velocity of the vehicle, for calculations for Latand Lon coordinates, and their corresponding deltas or differences, withlocal and global coordinate correction module(s).

FIG. 14 is for one embodiment of the invention, for a method forautomated vehicles, for adjusting R dynamically, based on rules engine,historical data, user-interface, or neural network, e.g., for filteringpurpose. FIG. 15 is for one embodiment of the invention, for a systemfor automated vehicles, for filtering module, for direction, velocity,and distance, e.g., using independent sensors and GPS.

FIG. 16 is for one embodiment of the invention, for a system forautomated vehicles, for filtering module, for power, power threshold(s),traffic data, maps, topography, R, number of nodes, and rate of changeof number of nodes, with a module for updating the new roads,intersections, and topographies, by user or automatically, as a feed,e.g. periodically or based on an event.

FIG. 17 is for one embodiment of the invention, for a system forautomated vehicles, for filtering module, for modifying region, forvarious vehicles, with relative position module and GPS, with conditionmodule, to compare and get all the relevant nodes or vehicles.

Here, we describe a method, as one embodiment: The first level offiltering is based on defining circle (geometry) of interest or anyother geometrical shape (see also FIG. 11). For the circular geometrycase, the objective is to ignore (not process) all nodes (vehicles) thatis outside a calculated radius R (see also FIG. 10). In one embodiment,the R is calculated based on the targeted safety applications combinedwith vehicle dynamics. For example, FCW (forward collision warning), BSW(blind spot warning), LCA (lane change assist), IMA (intersectionmovement assist), and CSW can all be implemented using 200 m (meter)radius. In one embodiment, as the vehicle speed decreases, the forwardapplication required coverage range decreases.

In one embodiment, for example, for calculating R, we have (see alsoFIG. 13):

R, as a function of host vehicle speed, F_(H), e.g.:

R=F _(H)(V)=50+2V+(V ²/8)

Where V is the host vehicle speed in m/s.

In one embodiment, F is a function of velocities, distances, andcoordinates, both in absolute values and relative values, for host andother vehicles. In one embodiment, F is a function of polynomial ofdegree G, in host vehicle speed V. In the example above, we have: G=2.

For example, for: 70 m≦R≦200 m

That is, Maximum (R)=200 m, and

Minimum (R)=70 m.

The 70 meter will still be sufficient to do all the rear applications.These numbers are just examples for some specific applications.

In one embodiment, the next step is to convert this R to deltaLongitudinal and delta Latitude from the host vehicle coordinate. Theobjective here is to ignore all vehicles that are outside a radius.Here, we assumed circular filtering. Different types of geometricfiltering can also be done: rectangle, ellipse, other irregulargeometry, or any other regions or shapes. For circular filtering, giventhe current host vehicle (HV) coordinate (lat_HV, lon_HV), and given thedesired filtering radius R, then the equivalent delta latitude(Delta_lat) and delta longitudinal (Delta_lon), from (lat_HV, lon_HV)for this radius R, are calculated as follows (see also FIG. 13):

Delta_lat=(R/Radius_of_earth)=(R/6378137),

e.g., based on Earth Equatorial radius of 6378137 m,

and where R is in meter (m).

Delta_lon=arcsin(sin(Delta_lat)/cos(lat_HV))

Therefore, in one embodiment, to apply the filtering algorithm for anynode (Remote Vehicle (RV)), with the coordinate of (lat_RV, lon_RV), thefollowing is executed (see also FIG. 13, for Comparison Module andCondition Module):

If

Abs(lat_RV−lat_HV)>Delta_lat

OR

Abs(lon_RV−lon_HV)>Delta_lon

Then: Ignore it (i.e., do not process it).

Else: Process it.

Wherein all “lat” and “lon” values are expressed in radian. The defaultvalue for R is 200 m, but it is configurable. For jam reduction andreduction of processing, in one embodiment, we want to ignore all thevehicles outside of the radius R.

Now, in one embodiment, this value of R can be adaptively adjusted basedon the statistical distribution of the nodes ranges (see also FIG. 12).For example, if the maximum number of nodes that can be processed is150, and the calculated R=200 m, and the number of nodes in the 200 mradius is 200 nodes, but most of those nodes are close to the 200 mrange, then the R value can be adaptively adjusted (reduced), so we getclose to the 150 desired total numbers of nodes. For example, this canbe done in small steps with AR, in a loop, reducing the value of Rslightly, each time (in each step), and measuring the nodes or vehicleswithin the new radius, and the process continues, until we get 150 nodesor less in that radius, and then we exit the loop, and stop the process(see also FIG. 14). Then, we select the final radius as the radius forthe formulation and next steps.

In one embodiment, the second level of filtering is based on therelative velocity between the host vehicle and the remote vehicle. Forexample, for all remote vehicles that have a value of the velocitycomponent in host vehicle direction that is greater than the hostvehicle velocity, and they are also at relatively high range distancefrom the host vehicle, then they constitute no immediate threat on thehost vehicle (based on the probability) (see also FIG. 15). Thus, thosevehicles can be filtered out.

In one embodiment, the third level of filtering is to adjust either thetransmitted power and/or the received power threshold as a function ofone of the following (as different embodiments) (see also FIG. 16):

a. Rate of change in the number of received nodes. As the number ofnodes increases sharply, the host vehicle is approaching a congestedtraffic area, and therefore, the transmitted power can be decreased toreduce the communication range, and/or the received power threshold canbe increased to reduce the receiving communication range (see also FIG.16).

b. The map database can also be used very effectively: For example, ifthe number of connected road segments to the host vehicle road segmentis high, and/or the total number of road segments is high within adefined area, then the transmitted power can be decreased, and/or thereceived power threshold can be increased (see also FIG. 16).

c. Based on the calculated R. For example, communication range Rdecreases/increases, as the transmission power increases/decreases (seealso FIG. 16).

In one embodiment, the fourth level of filtering is just using the mapdatabase: For example, filter all the nodes (vehicles) that are on roadsegments that are not connected to the host vehicle road segment. Anexample for that is the main road and an overpass geometry. The mainroad and the overpass that passes over it are not connected, and thus,they do not make a V2V (vehicle to vehicle) possible traffic hazard. Mapdatabase can provide this information that these two road segments arenot connected (see also FIG. 16).

The advantages of our methods are very clear over what the currentstate- of-the-art is. Our methods optimally use the available processingpower and available bandwidth on processing the data of the desirednodes, which are relevant or important. They also help reducing thecommunication congestion problem.

Tracking the Heading Angle of the Pedestrian

Here, we describe embodiments for tracking the heading angle of thepedestrian system and method.

The purpose of this approach is to track the heading angle of thepedestrian using existing sensors integrated in to a smart phone deviceor other mobile devices, e.g., wearables or smart watches.

The system tries to use the following data when it is available:

a. GPS—GPS position—GPS speed—GPS heading

b. Compass heading

c. Three rotation measurements (pitch, yaw, roll)

d. Three acceleration measurements (down, longitudinal, lateral)

In general, when a pedestrian is moving, it is an easy task to track itspositions, and therefore, its heading. However, when the pedestrian isstopped, but changing his direction, tracking the heading, as hisintended direction of travel, becomes a more difficult job. (See FIG.41.)

High level algorithm:

Step 1:

Calculate heading from GPS position:

ψ_(p)=arcTan(ΔE/ΔN). (arc tan is the tan inverse function)

See FIG. 42.

To see a significance difference in the position from one time epoch toa later one, this equation may apply at a lower data rate.

Step 2:

Based on the heading measurement, ψ_(GPS), and/or the calculated one,ψ_(p), try to best-match the pedestrian walk with the intendedintersection segment. This will be the initial high probabilitycandidate (IC1). The second candidate is the one perpendicular to it(IC2). See FIG. 43.

Step 3:

Determine if the pedestrian stopped.

-   -   a. Detect a drop in speed. Watch the speed profile and look for        a drop from a consistent profile. See FIG. 44.    -   b. Look for a centralized cloud of positions. See FIG. 45.    -   c. Watch for increase in longitudinal acceleration (−ve), after        a consistent behavior. See FIG. 46.

At the end of Step 3, the pedestrian stop flag will either be set(value=1) or not changed at all (value=0).

Step 4:

If the stop flag is never set and the position of the pedestrian iswithin G=2 meter radius from the surveyed edge of the intersection, thenIC1 is held as the intended driving path.

Step 5:

If StopFlag=1, then it is important to watch the behavior of the compassheading angle, ψ_(c), before the stop and during the stop. See FIGS. 47and 48. We are looking to detect a behavior like this.

We are trying to capture a turn maneuver by the pedestrian. Another wayof doing it, if yaw rate signal is available, is to watch integration ofthe yaw rate for a window of T=1-2 sec. See FIGS. 49-50.

Step 6:

Offset the last ψ_(p) and/or ψ_(GPS) (before stop) by the value ofΔψ_(c) or Δψ (call it ψ_(p) corrected). (See above.)

Step 7:

Repeat Step 3 with ψ_(p) corrected.

Step 8:

Once the pedestrian starts walking again, check how the ψ_(p)-correctedis correlated with the new ψ_(p).

FIGS. 51-54 show the embodiments of the systems of this invention.

Here are some examples: A method for safe crossing for pedestrians in astreet or highway, said method comprising: a central computer receivingglobal positioning system location data for a pedestrian during a firsttime period from a remote location; said central computer calculating anangle for heading and a vector for direction of said pedestrian, usingsaid global positioning system location data for said pedestrian duringsaid first time period; said central computer predicting a first choicecandidate for intended intersection segment for said pedestrian tocross, based on said angle for heading and said vector for saiddirection of said pedestrian; said central computer predicting a secondchoice candidate for intended intersection segment for said pedestrianto cross, based on said angle for heading and said vector for saiddirection of said pedestrian; wherein said first choice candidate forintended intersection segment for said pedestrian to cross isperpendicular to said second choice candidate for intended intersectionsegment for said pedestrian to cross; said central computer monitoringspeed profile for said pedestrian.

If said central computer detects a drop from consistent range of saidspeed profile for said pedestrian, then said central computerdetermining that said pedestrian is stopping; said central computerdetermining cluster of positions for said pedestrian at rest status;said central computer monitoring acceleration profile for saidpedestrian in 3 different dimensions; if said central computer detects alarge negative drop from consistent range of said acceleration profilefor said pedestrian, then said central computer determining that saidpedestrian is stopping; said central computer receiving a flag value forrest status; said central computer receiving a radius value thresholddistance; if said flag value for rest status is not true, and ifdistance between location of said pedestrian to an edge of anintersection for a street or highway is less than said radius valuethreshold distance, then said central computer selecting said firstchoice candidate for intended intersection segment for said pedestrianto cross.

If said flag value for rest status is true, then said central computerevaluating behavior of said angle for heading for said direction of saidpedestrian, before and during a stop event; a computation moduleintegrating yaw rate for said pedestrian, for a second time period, toget an integrated yaw rate; said central computer receiving saidintegrated yaw rate from said computation module; said central computeroffsetting said angle for heading for said direction of said pedestrianby said integrated yaw rate, to get a corrected angle for heading forsaid direction of said pedestrian; said central computer determining ifsaid pedestrian is stopping, using said corrected angle for heading forsaid direction of said pedestrian; if said central computer detects thatsaid pedestrian is walking, said central computer evaluating how saidcorrected angle for heading for said direction of said pedestriancorrelates with a recent value of said angle for heading for saiddirection of said pedestrian.

Other features are:

monitoring multiple people.

monitoring multiple cars.

monitoring multiple intersections.

warning multiple people.

warning multiple cars.

monitoring multiple global positioning values.

monitoring multiple global positioning devices.

communicating with multiple satellites.

communicating with multiple telephone companies.

communicating with multiple service providers.

connecting cars with pedestrians.

communicating with cars.

communicating with pedestrians.

communicating with cloud.

communicating with server farms.

communicating with police.

alarming police.

scanning intersections with more than 4 outlets or roads.

correcting position data by local devices positioned at intersections,based on interactions with cell phones of pedestrians nearby, toregister and record the position, and then later, compare those withother data, e.g., by satellite or GPS or maps.

Here are some examples: FIG. 41 is for one embodiment of the invention,for a system, for pedestrians moving at the intersection for a road.FIG. 42 is for one embodiment of the invention, for a system, fordirection, for the angle with respect to the coordinate system, with N-Eaxes. FIG. 43 is for one embodiment of the invention, for a system, fordirection, for the intended intersection paths, for possibilities.

FIG. 44 is for one embodiment of the invention, for a system, forpedestrian speed, before and after the stop. FIG. 45 is for oneembodiment of the invention, for a system, for pedestrian movement, forpositions, plus position at rest. FIG. 46 is for one embodiment of theinvention, for a system, for pedestrian acceleration, with consistentbehavior, plus deceleration to stop. FIG. 47 is for one embodiment ofthe invention, for a system, for angle, before the stop, plus the deltaangle, or the difference in angle.

FIG. 48 is for one embodiment of the invention, for a system, for angle,during the stop. FIG. 49 is for one embodiment of the invention, for asystem, for yaw rate. FIG. 50 is for one embodiment of the invention,for a system, for yaw rate integration. FIG. 51 is for one embodiment ofthe invention, for a system, for acceleration measurements.

FIG. 52 is for one embodiment of the invention, for a system, forintended intersection paths. FIG. 53 is for one embodiment of theinvention, for a system, for position at move and position at rest. FIG.54 is for one embodiment of the invention, for a system, for yaw rateand yaw rate integration.

FIG. 55 is for one embodiment of the invention, for a system, forcommunications between and from telephone company and satellite, to/fromperson's mobile phone or device, as well as the moving car, to connectthe car with the mobile device/phone/smart phone, for understanding theposition(s) of the pedestrian(s) at the intersections for the roads, bythe moving car, nearby. FIG. 56 is for one embodiment of the invention,for a method of implementation of tracking pedestrian heading angleusing smart phones data for pedestrian safety applications.

In this disclosure, any computing device, such as processor,microprocessor(s), computer, PC, pad, laptop, server, server farm,multi-cores, telephone, mobile device, smart glass, smart phone,computing system, tablet, or PDA can be used. The communication can bedone by or using sound, laser, optical, magnetic, electromagnetic,wireless, wired, antenna, pulsed, encrypted, encoded, or combination ofthe above. The vehicles can be car, sedan, truck, bus, pickup truck,SUV, tractor, agricultural machinery, entertainment vehicles,motorcycle, bike, bicycle, hybrid, or the like. The roads can beone-lane county road, divided highway, boulevard, multi-lane road,one-way road, two-way road, or city street. Any variations of the aboveteachings are also intended to be covered by this patent application.

1. A method for tracking pedestrian heading angle using smart phonesdata for pedestrian safety applications, said method comprising: acentral computer receiving global positioning system location data for apedestrian during a first time period from a remote location; saidcentral computer calculating an angle for heading and a vector fordirection of said pedestrian, using said global positioning systemlocation data for said pedestrian during said first time period; saidcentral computer predicting a first choice candidate for intendedintersection segment for said pedestrian to cross, based on said anglefor heading and said vector for said direction of said pedestrian; saidcentral computer predicting a second choice candidate for intendedintersection segment for said pedestrian to cross, based on said anglefor heading and said vector for said direction of said pedestrian;wherein said first choice candidate for intended intersection segmentfor said pedestrian to cross is perpendicular to said second choicecandidate for intended intersection segment for said pedestrian tocross; said central computer monitoring speed profile for saidpedestrian; if said central computer detects a drop from consistentrange of said speed profile for said pedestrian, then said centralcomputer determining that said pedestrian is stopping; said centralcomputer determining cluster of positions for said pedestrian at reststatus; said central computer monitoring acceleration profile for saidpedestrian in 3 different dimensions; if said central computer detects alarge negative drop from consistent range of said acceleration profilefor said pedestrian, then said central computer determining that saidpedestrian is stopping; said central computer receiving a flag value forrest status; said central computer receiving a radius value thresholddistance; if said flag value for rest status is not true, and ifdistance between location of said pedestrian to an edge of anintersection for a street or highway is less than said radius valuethreshold distance, then said central computer selecting said firstchoice candidate for intended intersection segment for said pedestrianto cross; if said flag value for rest status is true, then said centralcomputer evaluating behavior of said angle for heading for saiddirection of said pedestrian, before and during a stop event; acomputation module integrating yaw rate for said pedestrian, for asecond time period, to get an integrated yaw rate; said central computerreceiving said integrated yaw rate from said computation module; saidcentral computer offsetting said angle for heading for said direction ofsaid pedestrian by said integrated yaw rate, to get a corrected anglefor heading for said direction of said pedestrian; said central computerdetermining if said pedestrian is stopping, using said corrected anglefor heading for said direction of said pedestrian; if said centralcomputer detects that said pedestrian is walking, said central computerevaluating how said corrected angle for heading for said direction ofsaid pedestrian correlates with a recent value of said angle for headingfor said direction of said pedestrian.
 2. The method for trackingpedestrian heading angle using smart phones data for pedestrian safetyapplications, as recited in claim 1, said method comprises: monitoringmultiple people.
 3. The method for tracking pedestrian heading angleusing smart phones data for pedestrian safety applications, as recitedin claim 1, said method comprises: monitoring multiple cars.
 4. Themethod for tracking pedestrian heading angle using smart phones data forpedestrian safety applications, as recited in claim 1, said methodcomprises: monitoring multiple intersections.
 5. The method for trackingpedestrian heading angle using smart phones data for pedestrian safetyapplications, as recited in claim 1, said method comprises: warningmultiple people.
 6. The method for tracking pedestrian heading angleusing smart phones data for pedestrian safety applications, as recitedin claim 1, said method comprises: warning multiple cars.
 7. The methodfor tracking pedestrian heading angle using smart phones data forpedestrian safety applications, as recited in claim 1, said methodcomprises: monitoring multiple global positioning values.
 8. The methodfor tracking pedestrian heading angle using smart phones data forpedestrian safety applications, as recited in claim 1, said methodcomprises: monitoring multiple global positioning devices.
 9. The methodfor tracking pedestrian heading angle using smart phones data forpedestrian safety applications, as recited in claim 1, said methodcomprises: communicating with multiple satellites.
 10. The method fortracking pedestrian heading angle using smart phones data for pedestriansafety applications, as recited in claim 1, said method comprises:communicating with multiple telephone companies.
 11. The method fortracking pedestrian heading angle using smart phones data for pedestriansafety applications, as recited in claim 1, said method comprises:communicating with multiple service providers.
 12. The method fortracking pedestrian heading angle using smart phones data for pedestriansafety applications, as recited in claim 1, said method comprises:connecting cars with pedestrians.
 13. The method for tracking pedestrianheading angle using smart phones data for pedestrian safetyapplications, as recited in claim 1, said method comprises:communicating with cars.
 14. The method for tracking pedestrian headingangle using smart phones data for pedestrian safety applications, asrecited in claim 1, said method comprises: communicating withpedestrians.
 15. The method for tracking pedestrian heading angle usingsmart phones data for pedestrian safety applications, as recited inclaim 1, said method comprises: communicating with cloud.
 16. The methodfor tracking pedestrian heading angle using smart phones data forpedestrian safety applications, as recited in claim 1, said methodcomprises: communicating with server farms.
 17. The method for trackingpedestrian heading angle using smart phones data for pedestrian safetyapplications, as recited in claim 1, said method comprises:communicating with police.
 18. The method for tracking pedestrianheading angle using smart phones data for pedestrian safetyapplications, as recited in claim 1, said method comprises: alarmingpolice.
 19. The method for tracking pedestrian heading angle using smartphones data for pedestrian safety applications, as recited in claim 1,said method comprises: scanning intersections with more than 4 outlets.20. The method for tracking pedestrian heading angle using smart phonesdata for pedestrian safety applications, as recited in claim 1, saidmethod comprises: correcting position data by local devices positionedat intersections.